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Abstract 

TRIAD is a well known simple algorithm that generates the attitude matrix between two coordinate 
systems when the components of two abstract vectors are given in the two systems. TRIAD, however, is 
sensitive to the order at which the algorithm handles the vectors, such that the resulting attitude 
matrix is influenced more by the vector proccessed first. 

In this work we present a new algorithm, which we call Optimized TRIAD, that blends, in a specified 
manner, the two matrices generated by TRIAD when processing one vector first, and then when processing 
the other vector first. On the average, Optimized TRIAD yields a matrix which is better than either one 
of the two matrices in that it is the closest to the correct matrix. This result is demonstrated 
through simulation. 

L BACKGROUND 

When the components of two abstract vectors are given in two different coordinate systems, it is 
possible to find the orientation difference between the two systems. In particular, we can easily find 
the transformation matrix from one coordinate system to the other. TRIAD * is an algorithm that does 
just that The process of finding the matrix using TRIAD is as follows. Let and denote the column 

matrices whose elements are, respectively, the components of the two abstract vectors when resolved in 
body coordinates, and let v and denote, respectively, the two column matrices whose elements are 

the components of the abstract vectors when resolved in the other, usually reference, system. The 
algorithm calls for the computation of the following column matrices in body coordinates: 
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and the following corresponding column matrices in the reference system: 


Then the attitude matrix that 
follows: 


V V V'K* ’ll 


s ,= s . x s , 

3 1 2 


(2 a) 
(2.b) 
(2.c) 


transforms from body to the reference coordinate system is computed as 

(3) 


. T T , T 

A - r, + r 2 - « 2 + r 3 - Sj 


where T denotes the transpose. 

Following the process indicated in (1) and (2), we realize that the vector which is designated as 
first, is no rmaliz ed, but other than that, remains intact, whereas the other vector serves as a means 
to define the second vector in the triad pair which determines the attitude. There is, therefore, an 
uneven consideration of the two vectors where the first is given a preference in the determination of 
A. We say that the first vector serves as an anchor in the computation of the transformation matrix. It 
is, indeed, a good engineering practice to use the vector measured by the most accurate device as the 
anchor vector. For example, it is very logical to use the vector measured by a star tracker as anchor 
when the other vector is measured by magnetometers. One may wonder though whether this is the best one 
can do. We maintain that we can do better, and propose a TRIAD-based algorithm which yields better 
results. This algorithm, which we name Optimized TRIAD, is introduced next. 

n. THE OPTIMIZED TRIAD 

The accuracy of each vector-measuring device is quantified by the standard deviation of its error. 
Accordingly, the vector measured by a star tracker is assigned a standard deviation smaller than that 
assigned to a magnetometer, for example. Borrowing this notion, we assign a standard deviation to the 
TRIAD -computed attitude matrix that corresponds to the standard deviation of the anchor vector used in 
computing the matrix. Therefore, the attitude matrix A , in whose computation vector no. 1 is used as 

anchor, is assigned the standard deviation a , which is the the standard deviation of vector no. 1. 

Similarly, if vector no. 2 serves as anchor, we denote the computed attitude matrix by A^ and assign to 

it the standard deviation which is the standard deviation of vector no. 2. Actually, since the 

computation which yields the matrix is nonlinear and is based on both vectors, there is no simple 
linf.nr relation between the standard deviation of the anchor vector and that of the resulting matrix, 
but since we are concerned only with the relative accuracy of A } and A^, the expression of their 

accuracy by and respectively, fits well our final purpose. 


It is well known (see the appendix) that when y^ and y^ are independent unbiased scalar measurement of 
an unknown scalar, x, and their measurement errors have standard deviations and a^, respectively, 
then x, the linear unbiased minimum variance estimate of x, is given by: 


A 

x = 
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o + a 
1 2 


2 y 2 


(4) 
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Following ( 4 ), we postulate that given with its assigned standard deviation and with its 

assigned standard deviation o , we can find X’ , an estimate of A which is better than either A or A 

2 12 

when using the estimator of ( 4 ); that is, 
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( 5 ) 


An interesting aspect of this estimator (as well as that of ( 4 )) is the conclusion that adding some of 
the worse result to the better, may yield an estimate whose accuracy is greater than that of the 
better. Since A' is a result of the addition of fructions of two orthogonal matrices, A’ is not 
necessarily orthogonal, and thus is not a legitimate attitude matrix, unless it is orthogonalized. 
Since A’ is close to being orthogonal, one orthogonalization cycle, as follows , suffices: 


X = 0 . 5 [A* + (ft’ -1 ) 7 ] 


( 6 ) 


It should be noted that the inversion of A’ is an easy task since the inverse of a 3 x 3 matrix can be 
computed analytically. It is cumbersome, if not impossible, to prove analytically that X is better than 
either A^ or A^; however, we can try to show it empirically. This is done in the next section. 


m. ALGORITHM TESTING 


ffl.1 Static Testing 


In the static testing we chose some fixed attitude matrix, A , and the components of the unit 

true 

vectors v and v (two abstract vectors resolved in the reference system). Then A was used to 

* 2 true 

transform and to the body system. To each component of the latter we added white measurement 

noise drawn from a random number generator. The added noise was unbiased and had a standard deviation 
a t = 0.1 for the noise added to the components of the transform of and a^= 0.2 for the noise added to 

the components of the transform of v^. The noisy column matrices were designated as and TRIAD 


was then applied to the four column matrices as described in the preceding section, once when vector 
no. 1 was used as anchor and once when the other was used as anchor. This generated the attitude 
matrices A and A respectively, which then were used in (5) to generate A* that was used in (6) to 

yield the optimized orthogonal matrix A. The quaternions corresponding to A , A , A , and A were 

true 1 2 

computed and denoted by q t q^, and q respectively. The error quaternion of each transformation 


was computed as follows: 


^ = q I ® Ve (7) 

When q was we obtained Sq j( when q was q 2 we obtained 8q 2> and when it was q, we obtained 8q. (Note 

that with the choice of ( 7 ) for computing the erroneous quaternion, we assume that 8q is the 
transformation quaternion from the erroneous to the true coordinate system). Finally, we extracted from 
each 8q the corresponding rotation angle 89. We thus have expressed the error in the computation of the 
attitude by a single angular error. That error was the angle by which the computed coordinate system 
had to be rotated about the appropriate Euler axis in order to coincide with the true body coordinates. 

Since 89 is a random variable, we ran 100 runs (realizations), each for 60 sec and each starting with a 
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different seed. Along the time axis the computation was performed every second. We then averaged the 
100 realizations at each time point and obtained the ensemble average of each error, that is, we 
obtained: 


&Pj(t k ) = 


too 


too 
Z 69 
j=» 


t./V 


(8 .a) 


&P 2 (t k ) = 


1 

100 


100 

£ &P 2 /V 

j=l Z,J 


(8.b) 


too 

8&V - T55 1 %> (8 ' c) 

j = l 

where j denotes the number of the realization, and t denotes the point in time where TRIAD and Optimal 
TRIAD were performed. The value of 89^), &P 2 (t k ) &P(t k ) as function of t fc is presented in 
Pig. (i). We see that 69 was always the smallest. We also computed the running time average of each 



ensemble average from the beginning of the run to time t fc . In other words, we computed: 

(9a) 
i = l 

«?, „(«,) - 7 ! 85,0,) »•» 
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k 

* M = ~r z 5 ^ (t i ) (9 c) 

i = 1 

The value of 5<f> -ft), 8 <d (t ) and 5o (t ) as function of t is presented in Fie. 2. It is 

l,iv k 2,av k av k k c 



Fig. 2: Running Time Average of the Ensemble Average of the Error 

Associated with A, A, and A. 

1 2 


obvious from Fig. 2 that A is superior to either A^ or A^. In other words, on the average, the 
Optimized TRIAD yields better results for the case tested. 

m.l Dynamic Testing 

To check the influence of changing attitude, we repeated the same runs and computations as described 

before, for a changing A. The change in A was due to a the body rotation about an axis p defined as 
follows: 

p = I,, y «o) 

The rotation rate about this axis was 1 rpm. The graphs of the results of this case, which correspondto 
those presented in Figs. 1 and 2, are presented in Figs. 3 and 4 respectively. Since the idea behind 
this algorithm is borrowed from linear estimation theory of independent unbiased measurement errors, 
one would expect the ensemble average of the angular error to be zero; however, as can be seen in Figs. 

1 and 3, this is not the case. This discrepancy stems from the fact that the displayed error is 

not linearly related to the averaged matrices. Also, the errors in the computed matrices, A and A , 

1 2 

arc not really independent. 
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when A was changing. 

true 



Fig. 4: R unnin g Time Average of the Ensemble Average of the Error 

Associated with A , A,, and X when A was changing. 

1 2 true 

Finally, the vectors v and v^, which are the components of the two abstract vector resolved in the 

reference coordinates, were constant through all runs. The angle between the two vectors was close to 

90 . To investigate the behavior of the algorithm for a different separation angle, we chose two new v^ 

0 

and vectors the angle between which was close to 45 and ran the last test case. The results were 

similar to those presented in Figs. 3 and 4, only that, as expected, the errors of all three algorithms 
were nearly 25% higher. 
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V. CONCLUSIONS 


In this work we have presented a simple TRIAD-based algorithm, which we call Op timized TRIAD, that 
performs better than TRIAD itself. The algorithm consists of runing TRIAD twice, once with one vector 
as anchor and once with the other vector as anchor, and weight averaging of the two resultant matrices 
followed by one orthogonalization cycle. The weights are determined by the accuracy of the measuring 
devices that produced the vector measurements. The idea behind this algorithm is borrowed from linear 
estimation theory of independent unbiased measurement errors. However, although the blending of the two 
TRIAD-generated matrices is based on an unbiased minimum variance formula, the ensemble average of the 
angular error is not zero, as can be seen in Figs. 1 and 3. This, however, is no surprise, because the 
displayed error is not linearly related to the averaged matrices. Also, the errors in the computed 
matrices, A^ and A^, are not really independent. 

We have shown empirically that, indeed, the accuracy of the Optimized TRIAD is better than that of 
TRIAD even when the latter uses the vector measured most accurately as anchor. It should be noted 
though that in this statement we refer to the average performance. That is to say that occationally 
TRIAD may yield results which are better than those obtained using Optimized TRIAD, but on the average. 
Optimal TRIAD performs better. It is interesting to note that like in Kalman filtering, the correct 
blending of the better TRIAD-generated attitude matrix with the worse, yields, on the average, a result 
which is more accurate than the better. 


Theorem : Given y and y where: 
1 2 


Appendix 


and 


ElvJ = 0 


(2.a) 

(2.b) 

Then, the following linear estimator: 


E(vJ) = aj 


y r x + V 1 

y 2 = x + v 2 


E{v 2 ) = 0 (2.c) 

E{v*) = a 2 (2.d) 


X = 


2 2 
°1 + °2 


y. + 


i. 


2 2 J 2 
°1 + °2 


yields an unbiased minimum variance estimate of x. 


Proof : 

A linear estimator of x has the form: 


Substitution of (1) into (4) yields: 


x = k y + k y 
VI VI 


X = (k i+ k 2 )x + kv i+ k 2 v 2 


da) 

(l.b) 


e {v,v 2 J = 0 (2.e) 


(3) 


(4) 

(5) 
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( 6 ) 


Using (5) we can write the estimation error as folios: 


e 4 x - i - <1 - k,- k 2 )x ■ k jV k ; v ; 


Due to the unbiasedness of v and expressed in (2.a,c), we obtain from (6): 


E(e) = (1 - k t - k 2 )x 


(7) 


For the estimate to be unbiased, E(e) has to vanish, which yields the necessary condition for 
unbiasedness: 


Using (8), (4) becomes: 


and (6) becomes: 


Now 


k = 1 - k 

l 2 


x = (1 - k 2 )y x + k 2 y 2 


e = - k 1 v f k 2 v 2 


Var{e) = o 2 = E[e 2 - E{e} 2 } 


which in view of the unbiasedness of e becomes: 


o 2 = E[e 2 } 

e 


Substitution of (10) into (12) yields: 


°! - E ' k M + k 2 v 2 + “iVi’k 1 


Using (2.b,d,e) and (8), (13) becomes: 


\ - (1 ' + k 2°2 


( 8 ) 


(9) 


( 10 ) 


(ID 


( 12 ) 


(13) 


(14) 


We want the estimator to be of minimum variance. From (14) we see that we still hi|ve one more design 
parameter to choose; namely k^. Consequently, we choose so as to minimize o^. Searching for the 

minimum we differentiate (14) with respect to k 2 and equate the result to zero. This yields: 

- - 2 <> ' k X + V* ' 0 (15) 

2 

Consequently: 


k = 


'i 


2 2 2 
°l + °! 


(16.a) 


2 .... 

It can be easily verified that the stationary point which o has at this k 2 , is a minimum point. Using 
(16.a) in (8), we obtain: 
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(16.b) 
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